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Abstract:  Past  research  efforts  have  focused  on 

the  end-effector  tracking  control  of  redundant  robots 
because  of  their  increased  dexterity  over  their  non- 
redundant  counterparts.  This  work  utilizes  an  adap¬ 
tive  full-state  feedback  quaternion  based  controller  de¬ 
veloped  in  [5]  and  focuses  on  the  design  of  a  general 
sub-task  controller.  This  sub-task  controller  does  not 
affect  the  position  and  orientation  tracking  control  ob¬ 
jectives,  but  instead  projects  a  preference  on  the  config¬ 
uration  of  the  manipulator  based  on  sub-task  objectives 
such  as  the  following:  singularity  avoidance,  joint  limit 
avoidance,  bounding  the  impact  forces,  and  bounding 
the  potential  energy. 

1  Introduction 

In  many  robotic  applications,  the  desired  task  is  natu¬ 
rally  defined  in  terms  of  end-effector  motion.  As  a  re¬ 
sult,  the  desired  robot  trajectory  is  described  by  the  de¬ 
sired  position  and  orientation  of  a  Cartesian  coordinate 
frame  attached  to  the  robot  manipulator’s  end-effector 
with  respect  to  the  base  frame,  also  referred  to  as  the 
task-space.  Control  of  robot  motion  is  then  performed 
using  feedback  of  either  the  joint  variables  (relative  po¬ 
sition  of  each  robot  joint  pair)  or  the  task-space  vari¬ 
ables.  Unfortunately,  joint-based  control  has  the  unde¬ 
sirable  feature  of  requiring  the  solution  of  the  inverse 
kinematics  to  convert  the  desired  task-space  trajectory 
into  the  desired  joint  space  trajectory.  In  contrast, 
task-space  control  does  not  require  the  inverse  kine¬ 
matics;  however,  the  precise  tracking  control  of  the  end- 
effector  orientation  complicates  the  problem.  For  ex¬ 
ample,  several  parameterizations  exist  to  describe  the 
orientation  angles,  including  minimum  three-parameter 
representations  (e.g.,  Euler  angles,  Rodrigues  parame¬ 
ters,  etc.)  and  the  non-minimum  four-parameter  rep¬ 
resentation  given  by  the  unit  quaternion.  Whereas  the 
three-parameter  representations  always  exhibit  singu¬ 
lar  orientations  {i.e.,  the  orientation  Jacobian  matrix 
in  the  kinematic  equation  is  singular  for  some  orien¬ 
tations),  the  unit  quaternion-based  approach  can  be 
used  to  represent  the  end-effector  orientation  without 
singularities.  Thus,  despite  significantly  complicating 
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the  control  design,  the  unit  quaternion  seems  to  be  the 
preferred  method  of  formulating  the  end-effector  orien¬ 
tation  tracking  control  problem.  Some  past  work  that 
deals  with  task-space  control  formulation  can  be  found 
in  [2],  [9],  and  [22].  Specifically,  an  experimental  as¬ 
sessment  of  different  end-effector  orientation  parame¬ 
terization  for  task-space  robot  control  was  provided  in 
[2] .  One  of  the  first  results  in  task-space  control  of  ro¬ 
bot  manipulators  was  presented  in  [9].  Resolved-rate 
and  resolved-acceleration  task-space  controllers  using 
the  quaternion  parameterization  were  proposed  in  [22] . 

In  addition,  the  control  problem  is  further  complicated 
in  the  presence  of  kinematic  redundancy.  That  is,  to 
provide  the  end  user  with  increased  flexibility  for  ex¬ 
ecuting  sophisticated  tasks,  the  next  generation  of  ro¬ 
bot  manipulators  will  have  more  degrees  of  freedom 
than  are  required  to  perform  an  operation  in  the  task- 
space.  Since  the  number  of  joints  in  a  redundant  ro¬ 
bot  is  greater  than  the  dimension  of  the  task-space, 
one  can  show  that  joint  motion  in  the  null-space  of  the 
Jacobian  matrix  exists  that  does  not  affect  task-space 
motion  (this  phenomenon  is  commonly  referred  to  as 
self-motion).  As  noted  in  [14],  [15],  and  [19],  there 
are  generally  an  infinite  number  of  solutions  for  the 
inverse  kinematics  of  redundant  robots.  As  a  result, 
given  a  desired  task-space  trajectory,  it  is  difficult  to 
select  a  reasonable  desired  joint  trajectory  that  satis¬ 
fies  the  control  requirements  {e.g.,  closed-loop  stability 
and  boundedness  of  all  signals)  and  the  sub-tasks  {e.g., 
singularity  avoidance,  joint  limit  avoidance,  bounding 
the  impact  forces  and  bounding  the  potential  energy). 
Thus,  there  is  strong  motivation  for  control  of  redun¬ 
dant  robots  to  be  done  in  the  task-space.  For  work 
related  to  controllers  for  redundant  robots,  the  reader 
is  referred  to  [3],  [6],  [9],  [16],  [18],  [21],  [23]  and  the 
references  therein. 

This  paper  utilizes  the  adaptive  full-state  feedback 
quaternion  based  controller  developed  in  [5]  and  fo¬ 
cuses  on  the  design  of  a  general  sub-task  controller. 
The  novelty  of  this  work  is  the  systematic  integration 
of  the  sub-task  controller  while  simultaneously  achiev¬ 
ing  end-effector  tracking.  Other  efforts  have  been  pro¬ 
posed  in  [5],  [6]  and  [23],  but  in  these  approaches,  the 
sub-task  objective  is  an  add-on  to  the  tracking  objec- 


tive  without  integration  into  the  stability  analysis.  In 
[5],  a  sub-task  control  signal  was  introduced  and  can 
be  seen  in  equation  (2.211)  as  h(t).  In  the  stability 
analysis  of  [5],  this  sub-task  signal  is  inconsequential 
to  the  tracking  control  objective  as  long  as  h(t)  and 
h(t)  remain  bounded.  This  work  will  exploit  the  prop¬ 
erty  of  self-motion  for  redundant  robot  manipulators 
by  designing  a  general  sub-task  controller  that  meets 
the  above  conditions  while  controlling  the  joint  motion 
in  the  null-space  of  the  Jacobian  matrix  to  alleviate  po¬ 
tential  problems  in  the  physical  system  or  select  config¬ 
urations  that  are  better  suited  for  a  particular  applica¬ 
tion.  Specific  sub-task  controllers  will  be  designed  for 
singularity  avoidance,  joint  limit  avoidance,  bounding 
the  impact  forces  and  bounding  the  potential  energy. 
In  Section  2  the  dynamic  and  kinematic  models  are 
described  for  a  general  redundant  robot  manipulator. 
In  Section  3  the  tracking  objective  is  presented.  The 
tracking  closed-loop  error  system  is  presented  in  Sec¬ 
tion  4.  In  Sections  5  and  6,  both  the  general  sub-task 
controller  as  well  as  four  specific  sub-task  controllers 
are  presented.  A  numerical  simulation  was  completed 
for  each  specific  sub-task  and  the  results  are  presented 
in  Section  7.  Concluding  remarks  are  made  in  Section 
8. 

2  Robot  Dynamic  and  Kinematic  Model 

The  dynamic  model  for  an  n-joint  ( n  >  6),  revolute, 
direct  drive  robot  manipulator  is  described  by  the  fol¬ 
lowing  expression 

M(9)9  +  Vm(9,9)9  +  G(9)  +  Fd9  =  T  (1) 

where  9(t),9(t),  9(t)  £  Rn  denote  the  joint  position,  ve¬ 
locity,  and  acceleration  in  the  joint-space,  respectively. 
In  (1),  M{9)  £  RnX™  represents  the  inertia  effects, 
Vm(9,9)  £  R"x"  represents  centripetal-Coriolis  effects, 
G{9)  £  R"  represents  the  gravity  effects,  Fd  £  Rnxn 
represents  the  constant  positive  definite  diagonal  dy¬ 
namic  frictional  effects,  r(f)  £  R"  represents  the  con¬ 
trol  input  torque  vector.  The  subsequent  development 
is  based  on  the  following  properties  [12]. 

Property  1:  The  inertia  matrix  M(9)  is  symmetric 
and  positive-definite,  and  satisfies  the  following  in¬ 
equalities 

mi  ||£||2  <  £tM(0)£  <  m2  ||£||2  V£  £  Rn  (2) 

where  mi,  m 2  €  R  are  positive  constants,  and  ||-|| 
denotes  the  standard  Euclidean  norm. 

Property  2:  The  inertia  and  centripetal-Coriolis  ma¬ 
trices  satisfy  the  following  skew  symmetric  rela¬ 
tionship 

Q  M  ( 9 , 0)  -  Vm(9, 9)\  £  =  0  e  R” 

(3) 


where  M(9,9)  denotes  the  time  derivative  of  the 
inertia  matrix. 

Property  3:  The  left-hand  side  of  (1)  can  be  linearly 
parameterized  as  shown  below 

M{9)9  +  Vm{9, 9)9  +  G(9)  +  Fd6  =  Yg(d,  0, 0)  <j> 


where  (j>  £  Rp  contains  the  constant  system  pa¬ 
rameters,  and  the  regression  matrix  Yg  (•)  £  R"xp 
contains  known  functions  dependent  on  the  signals 
9(t),  9(t),  and  9{t). 

Let  £  and  B  be  orthogonal  coordinate  frames  attached 
to  the  end-effector  of  a  redundant  robot  manipulator 
and  its  inertial  frame,  respectively.  The  position  and 
orientation  of  £  relative  to  B  are  commonly  represented 
by  a  homogeneous  transformation  matrix,  T  (9)  £  R4x4 
which  is  defined  as  [12] 

T{0)  A  [  P(0)  1  (5) 

Uix3  1 

where  0iX3  —  [  0  0  0  ]  ,  the  vector  p(9)  £  R3  and 
the  rotation  matrix  R(9)  £  R3x3  represent  the  position 
and  orientation  of  the  end-effector  coordinate  frame, 
respectively.  From  this  homogeneous  transformation 
matrix,  the  constrained  four-parameter  unit  quaternion 
representation  can  be  used  to  develop  the  kinematic 
model.  From  (5),  a  relationship  between  the  position 
and  orientation  of  £  relative  to  B  can  be  developed  as 
follows  [13] 

P  A  fp 

where  fp  ( 9 )  £  R3  and  fq  ( 9 )  £  R4  are  kinematic  func¬ 
tions,  q{t)  =  [  q0(t)  (t)  ]T  £  R4  with  qa(t)  £  R 

and  qv(t)  £  R3.  The  variable  q(t),  as  given  in  (6), 
denotes  the  unit  quaternion  [7].  The  unit  quater¬ 
nion  represents  a  global  nonsingular  parameterization 
of  the  end-effector  orientation,  and  is  subject  to  the 
constraint  qTq  =  1.  Note  that,  while  fp(9)  is  directly 
obtained  from  (5),  several  algorithms  exist  to  deter¬ 
mine  fq(0)  from  R(9)  ([7]  and  [10]).  Conversely,  R(q) 
can  be  determined  given  the  unit  quaternion  parame¬ 
terization  [7] 

R(<l)  =  (qI  -  Qv)  h  +  2 qvqy  +  2g0gx  (7) 

where  I3  £  R3x3  is  the  standard  identity  matrix,  and 
the  notation  ox  €  R3x3  Va  =  [ai  02  CJ3]  ,  denotes  the 
following  skew-synnnetric  matrix 

0  -o3  a2 

ax  =  a  3  0  —  a\  .  (8) 

— 02  a\  0 

Velocity  relationships  can  be  formulated  by  differenti¬ 
ating  (6)  which  can  be  written  as 


where  9  ( t )  £  R"  denotes  the  velocity  of  £  in  a  general¬ 
ized  coordinate  system,  and  Jp  ( 9 )  €  R3xn,  Jq  (9)  £ 
R4x”  denotes  the  position  and  orientation  Jacobian 
matrices,  respectively.  To  facilitate  the  subsequent  con¬ 
trol  development  and  stability  analysis,  the  fact  that 
q(t)  is  related  to  the  angular  velocity  of  £  relative  to 
B ,  denoted  by  to(t)  £  M3  with  coordinates  expressed  in 
B,  via  the  following  differential  equation  ([1]  and  [13]) 

q  =  B(q)u  (10) 


where  the  Jacobian- type  matrix  B(q)  £  M4x3 
as  follows 


£(<?)  = 


1 

2 


-q 


T 

V 


(loh  -  Qv 


is  defined 
(11) 


where  B(q)  satisfies  the  following  useful  property 


Remark  1  During  the  control  development,  the  as¬ 
sumption  that  the  minimum  singidar  value  of  the  ma- 
nipulator  Jacobian,  denoted  by  <jm  is  greater  than 
a  known  small  positive  constant  6  >  0,  such  that 
max  { ||  J+  (d)||}  is  known  a  priori  and  all  kinematic  sin¬ 
gularities  are  always  avoided. 


Remark  2  The  dynamic  and  kinematic  terms  for  a 
general  revolute  robot  manipulator,  denoted  by  M(9), 
Vm(9,9),  G{9),  J{9),  and  J+{9),  are  assumed  to  de¬ 
pend  on  9(t)  only  as  arguments  of  trigonometric  func¬ 
tions,  and  hence,  remain  bounded  for  all  possible  9(t). 
During  the  control  development,  the  assumption  will  be 
made  that  if  p(t )  €  Too  then  9(t)  £  Too  (Note  that  q(t) 
is  always  bounded  since  q(t)T  q(t)  =  1). 


BT(q)B(q)  =  I3.  (12) 


3  Task-Space  Tracking 


The  final  kinematic  expression  that  relates  the  gener¬ 
alized  Cartesian  velocity  to  the  generalized  coordinate 
system  is  developed  as  follows 

^  =  J  (9)9  (13) 


where  (9),  (10)  and  (12)  were  utilized,  and  J  (9)  £ 
R6x"  is  defined  as  follows 


J(0)  = 


Jp  (9) 

BT  (q)Jq  (9) 


(14) 


To  facilitate  the  control  development,  the  pseudo¬ 
inverse  of  J(9)  is  denoted  by  J+(9)  £  Rrax6,  which 
is  defined  as  follows 

J+4JT(JJT)_1  (15) 


The  objective  for  the  redundant  robotic  system  is  to  de¬ 
sign  a  control  input  that  ensures  the  position  and  orien¬ 
tation  of  £  tracks  the  position  and  orientation  of  a  de¬ 
sired  orthogonal  coordinate  frame  £d  where  Pd(t)  £  R3 
denotes  the  position  of  the  origin  of  £d,  relative  to  the 
origin  of  B  and  the  rotation  matrix  from  £d  to  B  is  de¬ 
noted  by  Rd  (•)  €  R3x3.  The  standard  assumption  that 
Pd(t),  Pd(t),  pd(t ),  Rd  (•) ,  Rd  (•) ,  and  Rd  (•)  €  Coo  will 
be  utilized  in  the  subsequent  stability  analysis.  The 
position  tracking  error  ep(t)  £  R3  can  be  defined  as 
follows 

eP=Pd-p  (19) 

where  p(t)  was  defined  in  (5) .  If  the  orientation  of  £d 
relative  to  B  is  described  by  the  desired  unit  quater¬ 
nion,  qd(t)  =  [  q0d(t)  q^dif)  ]  e  r4>  then  similar 
to  (7),  the  desired  rotation  matrix  can  be  described  as 
follows 


where  J+(9)  satisfies  the  following  equality 

JJ+  =  h  (16) 

where  Iq  £  R6x6  is  the  standard  identity  matrix.  As 
shown  in  [14],  the  pseudo-inverse  defined  by  (15)  satis¬ 
fies  the  Moore-Penrose  Conditions  given  below 

JJ+J  =  J  J+JJ+=J+ 

(J+J)T  =  J+J  ( JJ+f  =  JJ+.  :  1  '  ' 

In  addition  to  the  above  properties,  the  matrix 
(/.„  —  J+J)  satisfies  the  following  useful  properties 


Rd(qd)  —  ( Qod  JudJ-vd)  I3  +  2 qvdqvd  +  2qodqvd ■  (20) 

As  in  (10),  qd(t)  is  related  to  the  desired  angular  veloc¬ 
ity  of  £d  relative  to  B,  denoted  by  Ud(t)  £  R3,  through 
the  kinematic  equation 

qd  —  B  (qd)  ud.  (21) 

To  quantify  the  difference  between  the  actual  and  de¬ 
sired  end-effector  orientations,  a  rotation  matrix  R()  £ 
R3x3  of  £  with  respect  to  £d  is  defined  as  follows 

R  —  Rd  R  =  (eo  ~  evev)  h  +  2e„e^  +  2e0ex  (22) 


(In  -  J+J)  (In  -  J+ J)  =  In  ~  J+  J 
(In  ~  J+  Jf  =  (In  -  J+J) 

J  (In  -  J+J)  =  0 
(In  -  J+  J)  J+  =  0 


where  the  unit  quaternion  tracking  error,  eq(t) 

[  e0(t)  eff(t)  ]T  £  R4  can  be  derived  as  follows 
[22]  and  Theorem  5.3  of  [11]) 


A_ 

(see 


eD 

QoQod  Qv  Qvd 

cv 

QodQv  QoQvd  “t”  Qv  Qvd 

where  In  £  R7^"-  is  the  standard  identity  matrix. 


(23) 


where  eq(t)  satisfies  the  constraint 


eqeq  =  el  +e„ev  =  1,  (24) 

which  indicates  that 

0<|M*)||<1  0  <  |e0(t)|  <  1  (25) 


where  03X3  £  R3x3  denotes  a  matrix  of  zeros, 

and  h(9)  £  R"  is  the  subsequently  designed  sub¬ 
task  controller  signal.  The  linear  parameterization 
Y (Pd,Pd,Pd,  eq,  9, 9,  h,  h)(j>  introduced  in  (29)  is  defined 
as  follows 

Y(f>  4  Miid  +  Vmud  +  G{6)  +  Fd9  (34) 


for  all  time. 

Based  on  the  above  definitions,  the  end-effector  posi¬ 
tion  and  orientation  tracking  objectives  can  be  stated 
as  follows 

||ep(t)||  — >  0  and  R(eq)  — >  73  as  t  — >  oo,  (26) 

respectively.  The  orientation  tracking  objective  given 
in  (26)  can  also  be  stated  in  terms  of  the  unit  quater¬ 
nion  error  of  (23).  Specifically,  it  is  easy  to  see  from 
(24)  that 

if  ||e„(f)||  — >  0  as  t  — >  oo,  then  |eo(f)|  — >  1  as  t  — >  oo; 

(27) 

hence,  it  can  be  stated  from  (22)  and  (27)  that 


where  Y (•)  £  Rnxp  denotes  the  measurable  regression 
matrix,  and  <f>  £  Rp  represents  the  constant  parame¬ 
ter  vector  (e.g.,  mass,  inertia,  and  friction  coefficients). 
To  obtain  the  closed-loop  dynamics  for  r(i),  the  time 
derivative  of  (31)  is  taken,  pre-multiply  the  resulting 
equation  by  M(9 ),  and  substitute  (1)  to  obtain  the  fol¬ 
lowing 


Mr  =  -Vmr  +  Yf>-  I<rr  -  (A jf 


(35) 


where  the  parameter  estimation  error  signal  <j>(f)  £  Rp 
is  defined  as  follows 


(36) 


if  ||e„(i)||  — >  0  as  t  — >  oo,  then  R(eq)  — >  Is  as  t  — >  oo. 

(28) 


4  Task-Space  Controller 

Based  on  the  open-loop  kinematic  tracking  error  sys¬ 
tem  given  in  [5]  and  the  subsequent  stability  analysis, 
the  control  input  is  designed  as  follows 


t  =  Ycj)  +  Krr  +  (A  J)T 


(29) 


Remark  3  A  benchmark  adaptive  controller  was  uti¬ 
lized  to  compensate  for  the  parametric  uncertainties 
present  in  the  dynamic  model  (e.g.,  mass,  inertia,  and 
friction  coefficients).  Alternatively,  a  robust  or  slid¬ 
ing  mode  controller  could  also  be  used  to  compensate 
for  modeling  uncertainties  not  restricted  to  parametric 
uncertainties  (e.g.  see  [f]). 


The  following  theorem  can  be  stated  regarding  the  sta¬ 
bility  of  the  closed  loop  system. 


where  Kr  £  R"xrl  is  a  positive-definite,  diagonal,  con¬ 
trol  gain  matrix,  and  <j>(t)  £  Rp  denotes  the  parameter 
estimate  vector  which  is  updated  according  to 

(j)=  YYTr  (30) 

with  T  £  Rpxp  being  a  positive-definite,  diagonal, 
adaptation  gain  matrix.  The  auxiliary  signal  r(t)  £  R” 
can  be  defined  as  follows 

r  =  ud~9  (31) 


Theorem  1  The  control  law  described  by  (29)  guaran¬ 
tees  global  asymptotic  end-effector  position  and  orien¬ 
tation  tracking  in  the  sense  that 


|eP(t)  |  — >  0  as  t  00 

(37) 

R( eq(t ))  — >  J3  as  t  — >  00, 

(38) 

as  well  as  that  all  signals  are  bounded  provided  h(9)  £ 
Coo  and  £  Coo ■  (Note  the  assumption  given  in 
Remark  2  has  been  utilized.) 


where  Ud(t)  £  R"  is  an  auxiliary  control  input  defined 
as  follows 


Proof:  See  [5]  for  proof. 


+  (I„  -  J+J )  h 

(32) 

where  K\,  K2  £  R3x3  are  positive-definite,  diagonal, 
control  gain  matrices,  the  matrix  A (t)  £  R6x6  is  defined 
as  follows 


ud  =  J+ A- 


Pd  +  Kiep 

-Rd^d  +  K 2ev 


A  = 


—h  03x3 

03x3  R-d 


(33) 


5  Sub- Task  Control  Objective 

In  addition  to  the  tracking  control  objective,  there  can 
be  sub-task  objectives  that  are  required  for  a  particular 
redundant  robot  application.  To  this  end,  the  auxiliary 
control  signal  h(0),  as  introduced  in  (32),  allows  for 
sub-task  objectives  to  be  integrated  into  the  controller. 
This  sub-task  integration  is  completed  by  designing  a 


framework  that  places  preferences  on  desirable  configu¬ 
rations  where  an  infinite  number  of  choices  are  available 
when  dealing  with  the  self-motion  of  the  redundant  ro¬ 
bot.  These  sub-tasks  are  integrated  through  the  joint 
motion  in  the  null-space  of  the  standard  Jacobian  ma¬ 
trix  by  designing  h(9).  Theorem  1  requires  that  h(0), 
dhQ^  €  £oo, provided  9(t)  €  £oo-  Based  on  Remark  2, 
and  the  proof  of  Theorem  1  it  is  clear  that  9(t)  € 

In  the  subsequent  section,  h(9)  will  be  designed  to  meet 
these  conditions.  In  the  event  that  a  subsequently  de¬ 
fined  Jacobian-related  matrix  loses  rank,  the  sub-task 
objective  is  not  guaranteed.  More  specifically,  if  the 
Jacobian-related  matrix  maintains  full  rank,  then  the 
sub-task  objective  is  met  as  proven  in  the  subsequent 
stability  analysis. 

6  Sub-Task  Closed-Loop  Error  System 

In  this  section,  a  general  sub-task  closed-loop  error 
system  is  developed.  To  this  end,  an  auxiliary  signal 
ya(t )  €  R+  is  defined  as  follows 


0  <  ya{t)  <  1,  and  that  as  (3(9)  increases,  ya(t )  de¬ 
creases.  This  definition  of  ya(t)  is  arbitrary  and  many 
different  positive  functions  could  also  be  utilized. 

The  following  theorem  can  now  be  stated  regarding  the 
performance  of  the  sub-task  closed-loop  error  system. 

Theorem  2  The  control  law  described  by  (43)  guaran¬ 
tees  that  ya(t)  is  practically  regulated  (i.e.,  ultimately 
bounded)  in  the  following  sense 

\Va(t) |  <  J\y%(t0)\exp  (~2jt)  +  ^  (45) 

provided  the  following  sufficient  conditions  hold 

\\js(ln~  J+J)\\2  >6  (46) 

and 

k *■  >  k  <47> 

where  e,  7,  6,  62  €  R+  are  constants. 


ya  =  exp  (~a/3(9)) 


(39) 


where  a  €  R+  is  a  constant,  (3(9)  €  R+  is  selected  for 
each  sub-task,  and  exp(-)  is  the  standard  logarithmic 
exponential  function.  To  determine  the  dynamics  of 
ya(t ),  the  time  derivative  of  (39)  is  taken  and  can  be 
written  as  follows 

Va  =  Js'9  (40) 

where  a  Jacobian- type  vector  Js(t)  €  Rlxn  is  defined 
as  follows 

dya 
d9  ' 


J,  = 


(41) 


From  (40),  a  substitution  can  be  made  for  9(t)  and  the 
following  expression  for  ya(t)  can  be  written  as  follows 


Va 


JsJ+A-1 


pd  +  A'iep 

+  K  2ev 


+Js  (In  ~  J+J)  h  -  Jsr 


(42) 


where  (31)  and  (32)  were  both  utilized.  Based  on  the 
dynamics  of  (42)  and  the  subsequent  stability  analysis, 
the  sub-task  control  input  can  be  designed  as  follows 

h  =  -ksl  [Js(ln~  J+J)]Tya  (43) 

where  ksi  €  R+  is  a  constant  gain.  After  substituting 
(43)  into  (42),  the  following  expression  can  be  obtained 


Va 


JSJ+  A”1 


Pd,  +  KieP 

+  K^e  v 


-Jsr  -  ksi 


Js(ln-J+J)\\2ya 


(44) 


Remark  4  The  auxiliary  signal  ya(t )  in  (39)  was  se¬ 
lected  because  of  the  useful  properties  of  the  logarith¬ 
mic  exponential  function.  From  (39)  it  is  clear  that 


Proof:  See  Appendix  A. 

Remark  5  In  the  subsequent  sub-sections,  specific 
(3  (9)  functions  will  be  designed  for  different  sub-task 
objectives.  Each  (3  ( 9 )  is  designed  specifically  to  only 
depend  on  9  (t) .  For  most  of  the  sub-task  objectives, 
the  problem  is  set  up  to  require  that  (3(9)  >0  which 
is  achieved  by  keeping  ya(t)  <  1.  From  (45),  it  is  clear 
that  ya(t)  <  1  if  the  following  inequality  holds 

^\vl(to)\  +  ^  <  1  (48) 

which  can  be  achieved  through  the  selection  of  the  ro¬ 
bot  manipulator’s  initial  condition,  control  gains  ks  1,  a , 
and  bounding  constants.  For  other  sub-task  objectives, 
the  problem  is  to  maximize  (3(9)  as  t  — >  00  (minimize 
ya(t)  as  t  — >  00).  From  the  result  of  Theorem  2  as 
seen  in  (45),  a  true  maximization  of  (3(9)  (minimiza¬ 
tion  of  ya  (t) )  is  not  achieved.  However,  an  increasing 
lower  bound  for  (3  (9)  (an  exponentially  decreasing  up¬ 
per  bound  for  ya(t ) )  is  achieved  from  (45). 

Remark  6  The  four  sub-task  objectives  as  described 
in  the  subsequent  sub-sections  are  met  only  if  the  suffi¬ 
cient,  conditions  as  described  by  (46)  and  (47)  are  met. 
These  sub-task  objectives  are  secondary  to  the  tracking 
objective  which  is  always  guaranteed  by  Theorem  1.  In 
the  event  that  the  sub-task  controller  attempts  to  force 
the  robot  manipulator’s  end-effector  to  take  a  path  not 
allowed  by  the  tracking  controller,  the  condition  in  (46) 
will  not  be  met;  hence,  the  result  of  Theorem  2  will  not 
hold.  With  this  fact  in  mind,  the  formulation  of  the 
desired  task-space  trajectory  and  the  sub-task  objectives 
require  careful  consideration  to  meet  both  the  tracking 
and  sub-task  objectives  simultaneously. 


6.1  Sub- Task  1:  Singularity  Avoidance 

The  objective  for  this  sub-task  is  to  keep  the  robot 
manipulator  away  from  configurations  that  result  in 
singularities,  and  hence,  decrease  the  manipulability 
of  the  robot  manipulator.  For  this  sub-task,  let  (3  ( 9 ) 
be  defined  as  the  manipulability  measure  of  a  robot 
manipulator  given  by  the  following  definition  [17] 

/ 3  =  \J det  [  JJT }  (49) 

where  det  [•]  is  the  determinant  of  the  6x6  matrix 
J  ( 9 )  JT  (0)  and  (3(9)  =  0  when  the  robot  is  in  a  sin¬ 
gular  configuration.  From  (39),  (45),  (48),  and  (49),  it 
is  clear  that  (3  (9)  >  0  Vf,  provided  the  sufficient  condi¬ 
tions  are  met,  hence  meeting  this  sub-task  objective. 


6.3.1  Upper  Bounding  the  Impact  Force: 

The  objective  for  this  sub-task  is  to  keep  the  robot  ma¬ 
nipulator  away  from  postures  that  are  “best”  suited  for 
impact  with  the  environment  for  a  given  end-effector 
velocity  and  point  of  contact,  hence  9(t)  and  77(f)  are 
predetermined  and  fixed.  To  this  end,  (3  (9) ,  is  defined 
as  the  denominator  of  (51),  and  can  be  written  as  fol¬ 
lows  [20] 

(3  =  r]T  JM~1JTrj.  (52) 

Large  values  of  (3  (9)  indicate  postures  with  small  im¬ 
pact  forces  at  the  end-effector  [20];  therefore,  the  goal 
of  this  sub-task  is  to  force  the  manipulator  into  pos¬ 
tures  that  results  in  larger  values  of  (3  (9).  From  (39), 
(45),  (48),  and  (52),  it  is  clear  that  (3  (9(t ))  >  0  Vf, 
provided  the  sufficient  conditions  are  met. 


6.2  Sub- Task  2:  Joint  Limits 

Joint  limits  are  a  mechanical  constraint  for  almost  all 
robot  manipulators.  In  (1),  the  joint  angles  repre¬ 
sented  by  9i(t)  £  M+  Vf  =  l..n  operate  in  the  range 
of  9i  £  [  9fn  6fax  ]  ,  where  <9“in,  9)aax  £  M+  are 
the  minimum  and  maximum  joint  limits  for  each  joint, 
respectively.  The  objective  for  this  sub-task  is  to  keep 
each  joint  angle  away  from  its  respective  joint  limits, 
while  executing  the  tracking  control  objective.  For  this 
sub-task,  the  auxiliary  signal  (3  (9)  is  defined  as  follows 


^  =  11 

»= l 

From  (50),  it  is  clear  that  (3  (9)  >  0  as  long  as  all  joints 
are  not  at  the  joint  limits.  From  (39),  (45),  (48),  and 
(50),  it  is  clear  that  (3(9)  >0  Vf,  provided  the  suffi¬ 
cient  conditions  are  met,  hence  meeting  this  sub-task 
objective. 


1  - 


9r 


-  1 


(50) 


6.3  Sub- Task  3:  Impact  Force  Configurations 

For  collision  applications  of  robotic  manipulators,  the 
user  often  requires  the  ability  to  specify  the  impact 
force  the  end-effector  makes  with  the  environment.  For 
hammering,  or  chiseling  applications,  the  user  may 
want  to  maximize  the  impact  force,  while  in  a  medical 
application,  the  desire  to  have  reduced  collision  force 
may  be  necessary.  To  study  these  concepts,  an  impact 
force  measure  is  defined  as,  F(t)  £  M,  which  can  be 
written  as  follows  [20] 


^  —(!  +  «)  9Ti] 
r\r  JM~xJTr\ 


(51) 


where  k  £  M  denotes  the  type  of  collision  (k  is  either 
zero  or  one),  9(t)  £  M3  is  the  velocity  vector  for  the 
two  colliding  bodies,  and  77(f)  £  M3  is  a  vector  normal 
to  the  plane  of  contact  for  the  two  colliding  bodies, 
M  (9)  £  Rnx"  is  the  inertia  matrix  as  found  in  (1). 
LTtilizing  (51),  impact  force  sub-task  objectives  can  be 
defined  to  either  upper  or  lower  bound  the  impact  force 
with  the  environment. 


6.3.2  Withstanding  Impacts:  An  alternate 
impact  sub-task  is  to  push  the  robot  manipulator  into 
postures  that  are  “best”  suited  to  withstand  impacts 
with  the  environment.  For  this  case,  let  (3  (9)  be  defined 
as  the  dynamic  impact  measure  given  by  the  following 
definition  [20] 


(3  =  \  det 


(J+f  APJ+ 


(53) 


Large  values  of  / 3  (9)  indicate  postures  with  high  impact 
forces  at  the  end-effector  [20] ;  therefore,  the  goal  of  this 
sub-task  is  to  force  the  manipulator  into  postures  that 
results  in  larger  values  of  (3  (9) .  From  (39),  (45),  (48), 
and  (53),  it  is  clear  that  (3(9(t ))  >  0  Vf,  provided  the 
sufficient  conditions  are  met. 


Remark  7  For  the  adaptive  control  paradigm ,  the 
constant  parameters  for  the  inertia  matrix  M  (9)  are 
not  precisely  known;  therefore,  estimates  of  these  para¬ 
meters  must  be  utilized  in  (52)  and  (53)  in  lieu  of  the 
actual  values.  The  matrix  inverse  of  the  estimate  of 
M  (9)  (i.e.f  M  (9))  can  be  guaranteed  through  the  use 
of  a  projection  as  described  in  [8]. 

6.4  Sub-Task  4:  Upper  Bounding  the  Potential 
Energy 

The  objective  for  this  sub-task  is  to  keep  the  robot 
manipulator  away  from  postures  that  result  in  an  un¬ 
necessarily  high  level  of  potential  energy.  With  the 
flexibility  inherent  to  redundant  robots,  a  posture  with 
less  potential  energy  is  more  desirable,  thus  providing 
an  increase  in  system  efficiency.  The  potential  energy, 
yu(f)  €  M,  stored  in  the  manipulator  can  be  defined  as 
follows  [17] 

n 

IX  —  —  [mu9o  pii  +  mmi9o  Pmi]  (54) 

i— 1 

where  mu,mmi  Vi  =  l..n  are  the  joint  and  rotor 
masses,  respectively,  g0  =  [  0  0  —  g  ]  ,  is  the  grav¬ 

itational  acceleration  vector  in  the  base  frame  where  g 


is  the  gravitational  constant,  Pmi  ( 0 )  6  R3  is  a  vector 
from  the  origin  of  the  base  frame  B  to  the  center  posi¬ 
tion  of  the  rotor,  and  Pu  (0)  £  M3  is  a  vector  described 
as  follows  [17] 

Pu  =  —  f  P*pdV  (55) 

ITT'li  Jvu 

where  p  £  M  is  the  density  of  the  elementary  particle  of 
volume  dV. ,  P*  ( 9 )  S  R3  is  a  vector  from  the  origin  of 
B  to  the  center  joint  position.  From  (54)  and  (55),  it  is 
clear  that  p(t)  is  a  function  of  0(f)  and  by  convention  is 
always  positive.  For  this  sub-task,  the  auxiliary  signal 
ya(t)  €  M  is  defined  as  follows 

2 la  =  9  ( 9 ) .  (56) 

The  goal  is  to  force  the  manipulator  to  take  postures 
with  less  potential  energy.  From  (45),  (48),  and  (56), 
provided  the  sufficient  conditions  are  met,  it  is  clear 
that  by  making  the  control  gain  ks\  large,  7  is  made 
large  (See  Appendix  A),  and  by  examining  (45),  it  is 
clear  that  the  potential  energy  will  have  an  exponen¬ 
tially  decreasing  upper  bounded. 

Remark  8  For  the  adaptive  control  paradigm,  the 
constant  parameters  for  the  rotor  and  joint  masses  are 
not  precisely  known;  therefore,  estimates  of  these  para¬ 
meters  must  be  utilized  in  (54)  and  (55)  in  lieu  of  the 
actual  values  as  discussed  in  Remark  1. 

7  Simulation  Results 

To  illustrate  the  performance  of  the  tracking  and  sub¬ 
task  controller  presented  above,  a  simplified  kinematic 
simulation  was  completed  for  a  planar  3-joint  revo¬ 
lute  robot.  This  robot  is  redundant  because  there 
are  3  joints  in  a  2  dimensional  task-space.  For  the 
simulation,  a  feedback  linearization  controller  was  uti¬ 
lized,  and  hence  the  adaptation  mechanism  was  not 
required1.  Specifically,  the  following  dynamic  model 
was  utilized 

M  (9)6 +  N  ( 9 , 0)  =  r  (57) 


where  p\  =  1.2746  [kg-m2],  p2  =  0.3946  [kg-m2], 
p3  =  0.0512  [kg-m2],  pi  =  0.4752  [kg-m2],  p5  = 
0.128  [kg-m2],  p6  =  0.1152  [kg-m2]  and  c2  =  cos(02), 

c3  =  cos(03),  and  c23  =  cos  (02  +  03) ,  N  (9, 9^j  £  M3 
represents  the  centripetal-Coriolis,  gravitational  and 
frictional  effects.  For  the  potential  energy  simula¬ 
tions  given  below,  the  gravitational  effects  G(9)  = 
[  Gr(0)  G2(0)  G3(0)  ]Twhere  G1(9),G2(9),G3(9) 
£  M  are  defined  as  follows 


Gi(9)  =  ^ mnghcl  +  mi2g(hcl  +  ^Z2cl2) 

+mi3g(hcl  +  I2cl2  +  ^Z3c123) 

G2(9)  =  ^mi2gl2cl2  +  mi3g(l2cl2  +  ^Z3cl23) 

G3(9)  =  \ni3gl3cl23 

where  the  center  of  mass  is  at  the  midpoint  of  each 
joint,  and  was  selected  as  follows:  nin  =  3.6  [kg], 
w/2  =  2.6  [kg],  and  mi3  =  2  [kg],  the  joint  lengths  were 
selected  as  follows:  l-\  =  0.40  [m],  i2  =  0.36  [m],  and 
i3  =  0.32  [m],  the  gravitational  constant  was  selected 
as  follows:  g  =  9.8  [^2],  and  cl  =  cos(0i),  cl2  = 
cos(0i  +  02),  cl23  =  cos  (6*i  +02  +03) ,  si  —  sin(0i), 
sl2  =  sin(01  +  02),  and  sl23  =  sin  (9\  +  92  +  03) .  Feed¬ 
back  linearization  can  be  used  to  linearize  (57)  as  fol¬ 
lows 

M  (0)  Uc  +  N  (0, 0)  =  r  (58) 

where  Uc(t)  £  M3  is  the  inner  loop  control  input.  After 
substituting  (58)  into  (57),  we  have 

0  =  Uc.  (59) 

The  task-space  is  defined  by  x(t)  £  M2,  where  x(t)  = 
[  x\ (t)  x2(t)  ]  ,  and  X\(t),  x2(t)  £  M  are  scalar 

euclidean  coordinates.  The  planar  3-joint  robot  has 
the  following  forward  kinematics  for  the  end-effector 


where  0(f),  r(t)  €  M3,  the  inertia  matrix  M  (0)  €  R3x3 
is  defined  as  follows 


'  Mu 

Mi  2 

Mi3 

M(0)  =  Mi  2 

m22 

m23 

Mi3 

M2  3 

m33 

where 

Mn  =  Pi  +  2pic2  +  2p5c23  +  2pec3  M22  =  p2  +  2p6c3 
Mi2  =  P2+  Pic2  +  p5c23  +  2p6c3  M23  =  p2  +  pec3 

M13  =p2+  p5c23  +  pqc3  M33  =  p3 

1  A  feedback  linearization  controller  was  utilized,  as  opposed 
to  an  adaptive  controller,  to  more  clearly  illustrate  the  perfor¬ 
mance  of  the  sub-task  objective. 


X\  _a  i\c\  +  £2cl2  +  £3c123 
x’2  £isl  +  £2s12  +  £3s123 


and  the  manipulator  Jacobian 


J(q)  ^ 


— ^isl  —  £2s12  —  £3s123 
£id  +  i2c  12  +  4cl23 

—£2s12  -  £3s  123  -£3sl23  ' 

£2cl2  +  £3cl23  £3cV23 


(60) 

(61) 


The  elimination  of  the  dynamics  and  rotational  track¬ 
ing  requirement  simplifies  the  control  problem,  there¬ 
fore  it  is  necessary  to  redefine  some  key  terms  to  estab¬ 
lish  a  simplified  closed-loop  error  system.  The  position 


tracking  error  signal  e(t)  £  M2  can  now  be  defined  as 
follows 

e  =  x-d  —  x  (62) 

where  the  desired  trajectory  xd(t)  £  M2  is  generated  by 
the  following  bounded  dynamic  system 


Xdl 

A_ 

'  —0.05  sin  (0. It) 

.  id2  . 

0.004  (cos  (O.lt))2  -  0.004  (sin  (O.lt))2 

(63) 

and  can  be  seen  in  Figure  1.  The  auxiliary  control  input 


Xdl(t)[m] 


Figure  1:  Desired  trajectory  for  three  link  robot. 

Ud(t)  as  defined  in  (32)  can  be  simplified  as  follows 

ud  =  J+  (Kse  +  xd )  +  (. h  ~  J+J)  h  £  M3  (64) 

where  Ks  £  M2x2  is  a  positive-definite,  diagonal,  con¬ 
trol  gain  matrix.  The  inner  loop  control  input  is  defined 
as  follows 

Uc  =  kQr  +  ud  +  JTe  (65) 

where  k0  £  R+is  a  positive  control  gain.  The  simplified 
closed-loop  error  system  can  now  be  written  as  follows 

r  =  ~k0r  —  JTe.  (66) 

To  demonstrate  the  performance  of  all  the  sub-task 
controllers,  a  different  simulation  was  completed  for 
each  sub-task.  The  initial  conditions  for  the  robot  ma¬ 
nipulator  in  each  sub-task  were  intentionally  selected 
to  make  /3  (9(to))  ~  0  (i.e.  maximize  ya(to))  to  demon¬ 
strate  that  (45)  holds  for  each  simulation  run.  In  the 
case  of  the  potential  energy  sub-task,  the  initial  condi¬ 
tions  for  the  robot  manipulator  was  selected  to  maxi¬ 
mize  y(to). 

7.1  Singularity  Avoidance 

To  demonstrate  the  sub-task  controller’s  performance 
for  singularity  avoidance  as  described  by  (39) ,  (43)  and 
(49),  the  robot  manipulator  was  initially  at  rest  at  the 
following  joint  positions  (i.e.  (3  (9 (to))  «  0): 

9(t-o)  =  [  0.45[rad]  0.0[rad]  3.1  [rad]  ]T 


with  the  gains  selected  as  follows 

Ks  =  diag{ 2, 2},  ko  =  2,  ks i  =  1  and  a  =  4 

where  diag{-}  denotes  a  diagonal  matrix  with  argu¬ 
ments  along  the  diagonal.  Both  the  tracking  and  sin¬ 
gularity  avoidance  sub-task  were  successfully  demon¬ 
strated,  and  can  be  seen  by  the  following  figures:  the 
manipulability  measure  f3  (9)  and  the  tracking  error  can 
be  seen  in  Figures  2  and  3,  respectively. 


Figure  2:  Manipulability  Measure 


Figure  3:  Tracking  Error 

7.2  Joint  Limits 

To  demonstrate  the  sub-task  controller’s  performance 
for  joint  limit  avoidance  as  described  by  (39),  (43),  and 
(50),  the  robot  manipulator  was  initially  at  rest  at  the 
following  joint  positions  (i.e.  /3  (9(to))  =  0): 

9(to)  =  [  0.5[rad]  1.5 [rad]  3.5 [rad]  ]T 

with  the  gains  selected  as  follows 

Ks  =  diag{  1,4},  ko  =  8,  ks\  =  1  and  a  =  1. 

The  joint  limits  were  set  to  the  following  values 
9fn  =  9fn  =  0.5 [rad]  and  9fn  =  0.1  [rad] 

0™ax  =  9?ax  =  2 [rad]  and  6^ax  =  6 [rad]. 


Both  the  tracking  and  joint  limits  sub-task  were  suc¬ 
cessfully  demonstrated  and  can  be  seen  by  the  following 
figures:  the  auxiliary  signal  / 3  ( 9 )  and  the  tracking  error 
can  be  seen  in  Figures  4  and  5,  respectively. 


Figure  4:  f3  (9)  for  Joint  Limits  Sub- Task 


Figure  5:  Tracking  Error 


7.3  Impact  Force  Configurations 

7.3.1  Upper  Bounding  the  Impact  Force: 

To  demonstrate  the  sub-task  controller’s  performance 
for  upper  bounding  the  impact  force  as  described  by 
(39),  (43)  and  (52),  the  robot  manipulator  was  initially 
at  rest  at  the  following  joint  positions: 

9(to)  =  [  0.45[rad]  0.0[rad]  2.9 [rad\  ]T  (67) 

with  the  gains  selected  as  follows 

Ks  =  diag{ 4, 4},  ko  =  3,  ks\  =  1  and  a  =  8. 

The  initial  conditions  as  described  in  (67)  places  the 
robot  in  a  configuration  resulting  in  (3  ( 6 (to ))  w  0,  (i.e. 
a  configuration  with  a  high  impact  force  potential) .  For 
this  simulation,  a  plane  of  contact  that  is  always  per¬ 
pendicular  to  xi axis  is  assumed,  so  ij(t)  =  [  1  0  ] 


and  is  fixed.  Although  contact  is  never  made,  the  sub¬ 
task  controller  works  to  place  the  robot  in  a  configu¬ 
ration  with  less  impact  force  potential  (i.e.  / 3(9(t ))  > 
/3(9(to))).  Both  the  tracking  and  upper  bounding  the 
impact  force  sub-task  were  successfully  demonstrated 
and  can  be  seen  by  the  following  figures:  the  denomina¬ 
tor  of  (51)  which  was  defined  as  (3  (9)  and  the  tracking 
error  can  be  seen  in  Figures  6  and  7,  respectively. 


Figure  6:  (3  (9)  for  Upper  Bounding  the  Impact  Force 
Sub- Task 


Figure  7:  Tracking  Error 


7.3.2  Withstanding  Impacts:  To  demon¬ 
strate  the  sub-task  controller’s  performance  for  with¬ 
standing  impacts  as  described  by  (39),  (43)  and  (53), 
the  robot  manipulator  was  initially  at  rest  at  the  fol¬ 
lowing  joint  positions: 

9 (t0)  =  [  0.1  [rad]  1.7 [rad]  4.5 [rad]  ]T  (68) 

with  the  gains  selected  as  follows 

Ks  =  diag{  1, 1},  ko  =  4,  ks\  =  1  and  a  =  1. 

The  initial  conditions  as  described  in  (68)  places  the 
robot  in  a  configuration  with  a  high  impact  force  po¬ 
tential.  For  this  simulation,  a  plane  of  contact  that  is 


always  perpendicular  to  desired  trajectory  is  assumed. 
Although  contact  is  never  made,  the  sub-task  controller 
works  to  place  the  robot  in  a  configuration  with  greater 
impact  force  potential  (i.e.  (3(9(t ))  >  (3{9(to))).  Both 
the  tracking  and  withstanding  impacts  sub-task  were 
successfully  demonstrated  and  can  be  seen  by  the  fol¬ 
lowing  figures:  the  withstanding  impacts  measure  f3  {9) 
and  the  tracking  error  can  be  seen  in  Figures  8  and  9, 
respectively. 


be  seen  by  the  following  figures:  the  potential  energy 
measure  g  (9)  and  the  tracking  error  can  be  seen  in 
Figures  fO  and  11,  respectively. 


Figure  10:  g  (6)  for  Upper  Bounding  the  Potential  Energy 
Sub- Task 


Figure  8:  (3  (9)  for  Withstanding  Impacts  Sub-Task 


Figure  11:  Tracking  Error 


8  Conclusions 


Figure  9:  Tracking  Error 


7.4  Upper  Bounding  the  Potential  Energy 

To  demonstrate  the  sub-task  controller’s  performance 
for  upper  bounding  the  potential  energy  as  described 
by  (43)  and  (56),  the  robot  manipulator  was  initially 
at  rest  at  the  following  joint  positions: 

9(to)  =  [  1.57[rad]  0.1[rad]  0.48[rad]  ]T 

with  the  gains  selected  as  follows 

Ks  =  diag{l,  1},  ko  =  2  and  ks i  =  1. 

Both  the  tracking  and  upper  bounding  the  potential  en¬ 
ergy  sub-task  were  successfully  demonstrated  and  can 


This  work  utilized  an  adaptive  full-state  feedback 
quaternion  based  controller  developed  in  [5]  and  fo¬ 
cused  on  the  design  of  a  general  sub-task  controller. 
This  general  sub-task  controller  was  developed  as  to 
not  affect  the  tracking  control  objective,  and  allows  for 
the  design  of  specific  sub-task  objectives.  Four  specific 
sub-tasks  were  designed  as  follows:  singularity  avoid¬ 
ance,  joint-limit  avoidance,  bounding  the  impact  forces, 
and  bounding  the  potential  energy.  Simulation  results 
are  presented  that  demonstrates  both  the  tracking  and 
sub-task  objectives  were  met  simultaneously. 
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Appendix 


A  Proof  of  Theorem  2 


Let  Vs  (t)  G  t  denotes  the  following  non-negative  function 

%  =  \vl  (69) 

After  taking  the  time  derivative  of  (69),  the  following  simplified 
expression  can  be  obtained 

^3  =  -k3l\\js{ln-J+J)\\2y2a  (70) 


J3J+  A”1 

Pd  +  Kxep 

—  J3r 

—R^uJd  +  K-  2ev 

where  (44)  was  utilized.  From  (39),  (41),  (56),  and  the  fact  that 
p{t)  G  £oo  from  Theorem  1,  Remark  2  can  be  used  to  show  that 
0(t)  G  jC oo5  hence,  it  is  clear  that  Js(0)  E  Coo  for  all  sub-tasks. 
From  Remark  1,  it  is  clear  that  J  (0)  and  J-*"  ( 9 )  E  Coo  and  has 
full  rank.  Utilizing  these  properties  we  have 

\\Js  {In-J+J)f  >8  (71) 


where  6  E  M  is  a  positive  constant.  From  the  above  bounded¬ 
ness  statements,  and  the  boundedness  assumptions  placed  on  the 
desired  trajectory,  the  following  upper  bound  can  be  made 


JsJ+A”1 


Pd  +  K  iep 
-Rdud  +  K2ev 


<6 1 


(72) 


where  E  M  is  a  positive  constant.  After  applying  the  bounds 
defined  in  (71)  and  (72),  the  expression  in  (70)  can  be  written  as 
follows 

v3  <  ~kslSyl  +  8\ya-  (73) 

The  expression  in  (73)  can  be  written  as  follows 

^3  <  -  (k3lS  -Vjvl  +  «1«2  (74) 

where  the  following  inequality  was  utilized 

\6iya\<  fyl  +  sfa  (75) 

02 


where  62  E  M  is  a  positive  constant.  Provided  ks  1,  6,  and  62  are 
selected  according  the  following  condition 


(  k3l6  -  7- )  >  0  then  ksl  >  A,  (76) 

V  02/  082 

the  expression  in  (74)  can  be  written  as  follows 
V3  <  -72/a  +  £ 


(77) 


where  7,  e  E  M+  are  bounding  constants.  After  substituting  (69) 
into  (T7),  the  following  expression  can  be  written 

Vz  <  —  27V3  +  e.  (78) 

After  integrating  each  side  of  (78),  the  following  solution  can  be 
written 

v3(t )  <  Vr3(«o)exp(-27t)  +  ^-  (1  -  exp(-27t)) .  (79) 

27 

From  (79),  it  is  clear  that  the  following  upper  bound  for  ya(t) 
can  be  written 

\ya{t)\  <  JlvZ(t o)|  exp(-27t)  +  ^  (80) 

thus  proving  that  t/a(£)E  £oo-  From  (43),  it  is  clear  that  h(0)  E 
£00  •  Utilizing  the  previous  bounding  statements  with  (44)  it  is 
clear  that  ya(t)  £  £00 •  After  taking  the  time  derivative  of  (43), 
it  is  clear  that  E  £00  • 


